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Abstract — An  increasing  variety  of  sensors  are  becoming 
available  for  use  onboard  autonomous  vehicles.  Given  these 
enhanced  sensing  capabilities,  scientific  and  military  personnel 
are  interested  in  exploiting  autonomous  vehicles  for  increasingly 
complex  missions.  Most  of  these  missions  require  the  vehicle  to 
function  in  complex,  cluttered  environments  and  react  to  chang¬ 
ing  environmental  parameters.  The  present  state-of-art  vehicles 
are  not  maneuverable  enough  to  successfully  accomplish  most  of 
these  tasks.  In  this  research,  a  nonlinear  controller  was  derived, 
designed,  implemented  in  simulation  and  onboard  a  AUV,  and 
in-water  tested  in  order  to  enhance  vehicle  maneuverability.  The 
structure  of  a  controller  is  hierarchical  such  that  an  ’’inner 
loop”  non-linear  controller  (outputs  the  appropriate  thrust 
values)  is  the  same  for  all  mission  scenarios  while  a  library  of 
’’outer-loop”  non-linear  controllers  are  available  to  implement 
specific  maneuvering  scenarios.  On  top  of  the  outer-loop  is  the 
mission  planner  which  selects  which  outer-loop  controller  will 
be  used.  The  algorithms  are  generic  and  in  no  way  vehicle 
specific  and  can  therefore  be  implemented  on  various  AUVs. 

I.  INTRODUCTION 

Autonomous  Underwater  Vehicles  (AUVs)  are  being  con¬ 
sidered  for  chemical  plume  tracing  [3],  [5],  [6],  [7],  mine- 
countermeasures  (MCM)  [9],  and  ship  hull  search  [2].  AUVs 
equipped  with  high-level  control  software  have  a  variety 
of  potential  applications  for  Anti-Terrorism/Force  Protection 
(ATFP)  objectives.  In  this  paper  we  present  the  design 
and  the  implementation  of  the  advanced  control  algorithms 
onboard  the  SPAWAR  Systems  Center’s  ship  hull  inspection 
platform.  In  addition,  we  show  the  latest  accomplishments 
at  the  Autonomous  Underwater  Vehicle  Festival  (AUVFest), 
June  6-15  2007,  held  in  Panama  City.  During  this  effort  we 
leveraged  the  existing  vehicle  sensors  and  improved  their 
use  by  introducing  novel  control  and  navigation  techniques. 
Vehicle  dynamics,  its  sensors,  and  the  environmental  factors, 
such  as  currents,  are  modeled  in  a  comprehensive  vehicle 
simulation.  Our  software  simulates  sensor  noise  and  perfor¬ 
mance  characteristics,  range  measurements,  acoustic  angle 
of  incidence  and  line-of-sight  requirements,  and  random 
drop  outs.  Simulation  environment  can  import  3D  models 
of  arbitrary  solid  objects,  such  as  ship  hulls,  sea  floor  terrain 
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maps,  quay  walls,  pier  pilings,  etc.  The  same  vehicle  and 
control  software  that  is  executed  in  simulation  is  executed 
onboard  of  the  AUV.  This  approach  significantly  reduces 
costly  in-water  testing  requirements  as  well  as  provides 
mission  plan  verification.  This  approach  accelerates  vehicle 
navigation,  control,  and  mission  development  since  we  can 
experiment  with  operational  challenges  without  asset  risk. 
Moreover,  the  simulator  can  be  used  as  a  great  operator 
training  tool  through  basic  operator  tele-operation  training. 
AUVs  equipped  with  this  type  of  software  can  greatly 
enhance  current  underwater  security  capabilities,  relieving 
divers  of  time-consuming,  dangerous  tasks,  therefore,  reduc¬ 
ing  manpower  and  mission  timeline  requirements. 

A.  Inner  Loop  Controller  Implementation 

In  this  subsection  we  describe  the  development  of  the 
inner  loop  controller  which  computes  the  desired  thrust 
values  to  achieve  the  commanded  velocities  and  angular  rates 
and  sends  the  commands  to  thrusters  which  create  vehicle 
movement.  The  vehicle  employed  for  simulation  and  in-water 
testing  is  a  thruster  powered  vehicle,  which  is  underactuated, 
since  it  does  not  have  thrusters,  thus,  direct  control  in  the 
lateral  direction.  Initially,  a  significant  amount  of  real-time 
sensor  data  was  collected  for  analysis  by  performing  various 
experiments  with  our  test-bed  AUV.  This  data  was  used 
to  estimate  vehicle  parameters  and  characterize  the  sensors. 
The  vehicle  parameters  were  approximated  for  all  five  inner 
loop  control  variables.  The  dynamics  equations  for  horizontal 
speed  (u),  vertical  speed  (w),  roll  rate  (p),  pitch  rate  (q),  and 
yaw  rate  (r)  were  derived  in  terms  for  non-linear  forces  acting 
on  the  vehicle  in  each  of  its  five  controllable  degrees-of- 
freedom.  Using  various  MATLAB  routines,  the  parameters 
were  approximated  for  (1)  Drag  Forces  -  two  parameters  per 
each  DOF,  (2)  Buoyancy  Force  and  Centers  of  Buoyancy 
in  each  3  directions,  (3)  Inertia  Terms  in  each  direction. 
These  parameters  were  then  used  in  a  Feedback  Linearizing 
controller,  whose  performance  depends  on  the  accuracy  of 
the  model.  Later  on,  the  expected  model  uncertainties  are 
compensated  for  using  a  novel  approach  to  back-stepping 
non-linear  control  technique.  The  controller  compensates 
well  for  the  hydro  forces  acting  on  the  vehicle.  All  inputs 
to  the  inner  loop  (and  to  each  outer  loop)  are  pre-filtered 
by  the  filter  of  the  specific  structure  that  we  designed.  The 
purpose  of  this  filter  is  to  produce  a  continuous  signal 
and  its  derivative  such  that  continuous  signal  closely  tracks 
command  generated  (or  user  specified)  desired  signal  within 
the  bandwidth  of  the  control  systems.  More  on  command 
filtering  is  elaborated  on  in  the  following  subsection. 
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B.  Outer  Loop  Controller  Implementation 

In  this  subsection  we  describe  the  development  of  various 
modes  of  outer  loop  controllers  which  compute  the  desired 
velocities  and  angular  rates  to  achieve  a  behavior  or  a  specific 
maneuver.  These  outer  loops  include  various  control  modes 
that  generate  commands  to  the  inner  loop.  Each  control  mode 
is  a  set  of  nonlinear  equations  that  implement  a  specific 
maneuver.  The  vehicle  uses  the  novel  translational,  attitude, 
and  altitude  controller  based  on  the  nonlinear  control  tech¬ 
nique  called  Back-stepping.  The  novel  controller  implements 
the  ideas  of  Back-stepping  and,  in  addition,  introduces  a 
new  algorithm  called  Command  Filtered  (CF)  Back-stepping. 
Several  places  in  this  paper  refer  to  filtering  of  a  signal  x°c  to 
produce  a  signal  xc  and  its  derivative  xc.  This  is  referred  to 
as  command  filtering.  The  motivation  of  command  filtering 
is  to  determine  the  signals  xc(t)  and  xc(t)  as  needed  for  the 
next  iteration  of  the  backstepping  procedure  [10],  without 
having  to  analytically  differentiate  x°,  because  the  analytic 
differentiation  becomes  overly  cumbersome  for  systems  of 
high  dimension.  The  first  objective  was  to  control  the  vehi¬ 
cle’s  attitude  or  orientation  angles  (roll,  pitch,  and  yaw),  and 
to  maintain  vehicle’s  depth.  This  basic  outer  loop  is  described 
in  this  paper  in  Section  V.  We  refer  to  this  loop  as  middle 
loop  controller  since  it  is  used  by  each  of  the  outer  loops.  Our 
test-bed  AUV  is  capable  of  maintaining  attitude  (roll,  pitch, 
and  yaw)  using  the  Back-stepping  Attitude  Controller  (BAC) 
which  outputs  appropriate  angular  rate  commands  ( p° ,  q°, 
r°)  to  the  angular  rate  inner  loop.  Depth  control  is  achieved 
using  Back-stepping  Depth  Controller  (BDC),  which  outputs 
appropriate  vertical  speed  command  (w°).  Tracking  of  the 
desired  trajectory  is  achieved  using  Back-stepping  Trajec¬ 
tory  Controller  (BTC),  which  commands  appropriate  vehicle 
speed  (u°)  and  yaw  (t/>°). 

This  paper  is  formatted  as  follows.  Section  II  defines 
vehicle  dynamics.  Section  III  summarizes  the  control  signals 
that  are  implemented.  Section  IV  shows  the  derivation  of  the 
waypoint  guidance  algorithm.  Section  V  derives  the  attitude 
controller.  Section  VI  presents  the  velocity  and  angular  rate 
controller.  Section  VII  describes  the  results  from  AUVFest. 
Finally,  Section  VIII  outlines  potential  new  control  design. 

II.  THRUSTER  POWERED  AUV  DYNAMICS 

Let  the  vehicle  dynamics  be  described  as  [4] 


p 

=  RUb 

(1) 

0 

=  Clu 

(2) 

Vb 

=  M  1{U\—  Fniin) 

(3) 

LO 

—  J  (tt2  MnLin) 

(4) 

where  p  =  [x,  y,  d\  is  the  earth  relative  position,  R jj  is  the 
rotation  from  body  to  earth  frame,  Vb  =  [it,u,u>]T  is  the 
velocity  in  body  frame,  0  =  [</>,  9,  i/j]  is  the  attitude,  O  is  a 
nonlinear  (nonsingular  except  at  6  =  f )  matrix  function  of 
0,  to  is  the  inertial  rotation  rate  vector  represented  in  body 
frame,  Fnnn  represents  the  body-frame  nonlinear  forces, 
Mniin  represents  the  body-frame  nonlinear  moments,  u\  is 
the  vector  of  control  forces,  u-i  is  the  vector  of  control 


moments.  The  control  forces  and  moments  are  generated  by 
a  set  of  five  thrusters  mounted  to  achieve  full  angular  rate 
control  (i.e.,  u>),  surge  control  (i.e.,  it),  and  heave  control 
(i.e.,  w).  The  vector  T  =  [T], . . . ,  T5]t  of  five  thrusts  is 
related  to  the  the  control  forces  and  moments  by  a  known 
thrust  distribution  matrix  such  that  u\  =  LfT  and  112  = 
LmT  where  Lf  G  3?2x5  and  Lrn  e  9?3x5.  The  AUV  is 
underactauted  since  the  lateral  speed  v  is  not  directly  affected 
by  the  thrusters. 

The  rotation  matrix,  R is  defined  as 

cOcip  cipsOstf)  —  ccjisip  apci/isO  +  scjisip 
cOstf)  c<j)ctp  +  sdsfaip  —cipscj)  +  c<fis9sip  , 

— s  9  c9s(f>  c9ccj) 

and  the  angular  rate  transformation  matrix.  Cl,  as 


Cl  = 


1  s<pt9  c4>t9 
0  c  <)>  — s  (j> 

0  s^/c0  c<j)/c9 


where  the  symbols  cz,  sz,  and  tz  represent  cos(z),  sin(z), 
and  tan(z). 


III.  CONTROL  SIGNALS  IMPLEMENTATION 


This  section  summarizes  the  control  law.  The  stability 
analysis  is  rigorously  analyzed  in  [1],  Due  to  lack  of  space, 
the  arguments  are  not  repeated  herein.  The  following  equa¬ 
tions  represent  the  control  signals 

O  _  II  [  Fx  KXyX  ~\~  XC,  Fy  ICXy\j  t/C]  || 

Uc  ~  3  c 0 

4>°  =  atan2  [s  (~Fy  -  Kxyy  +  yc)  ,s  (~FX  -  Kxyx  +  xc)\ 

0  u  sin(0)  —  cos(0)  sin(0)u  —  Kdd  +  dc 
W°  cos (9)  cos(<f>) 

uj°  =  Cl  1  (-KeQ  +  0C  —  Qbs'j 

U\  —  M (Fniin  ICvVb  Vbc  Vbbs') 

U‘2  ~\~  UJC  (Xbs)  1 


where  s  =  ±1  and  ipbs,  Ubsi  and  u>bs  are  defined  in 
eqns.  9,  8,  11,  and  14,  respectively.  Because  in  this  article, 
the  9  and  (j>  commands  are  externally  generated,  while  U  is 
used  as  a  control  variable,  only  yaw  backstepping  term,  t/»bs, 
must  be  defined  for  implementation  of  u>°  signal,  which  is 
done  in  Section  IV.  The  terms  9bs  and  are  identically 
zero.  The  term  Vbbs  is  the  vector  notation  of  Ubs  and  Wbs 
terms  while  u>bs  is  the  vector  notation  of  pbs,  qbs ,  Tbs  terms. 
For  s  =  1  the  vehicle  drives  forward  while  for  s  =  —  1 
the  vehicle  drives  backward.  Also,  because  this  is  trajectory 
following,  it  is  assumed  that  the  speed  ||(xc,  yc)||  is  non-zero 
and  we  have  selected  a  solution  for  which  the  AUV  forward 
velocity  is  always  positive. 

Eqn.  (6),  in  Section  IV,  has  the  form. 


u°  ci>° 

K  s  rc 


Vd  FXyF 


where 


Vd 


cos(0)  (  Fx  +  Xc) 

cos(g)  (-Fy  +  yc) 


and  E  = 


cosjg)^) 
cos(^)  (^) 


The  quantity  vd  is  the  velocity  vector  that  would  cause 
the  vehicle  to  follow  the  trajectory  given  that  the  vehicle 
was  currently  on  the  trajectory.  The  quantity  KxyE  is  the 
feedback  term  that  would  cause  the  vehicle  to  converge 
toward  the  trajectory. 

For  the  stability  analysis  to  follow,  the  value  of  Kxy  must 
be  positive;  however,  its  magnitude  must  be  selected  with 
care.  The  reasoning  on  how  to  select  it  is  explained  in  detail 
in  [1]. 


IV.  OUTER  LOOP:  WAYPOINT  GUIDANCE 

The  inputs  to  this  outer  loop  are  (after  command  filtering) 
xc(t),  yc(t ),  dc(t),  <j>c(t),  9c(t),  and  the  derivatives  of  these 
signals.  This  section  is  concerned  with  the  control  of  [a:,  y,  d] 
by  specification  of  desired  values  for  [it,  ip,  w\  which  will  be 
passed  to  the  inner  and  middle  loop  controllers  as  command 
signals. 

This  section  has  two  subsections.  Subsection  IV-A  is 
concerned  with  control  of  [x,y\  by  specification  of  [u°,ip°]. 
Subsection  IV-B  is  concerned  with  control  of  [z]  by  specifi¬ 
cation  of  [<]. 


A.  Mode:  XY  Translation 


Kinematic  Analysis.  Since  v  is  not  controllable  and  w  is 
used  to  control  depth  we  will  control  x  and  y  by  calculating 
appropriate  Ud  and  ipd  signals.  For  clarity,  we  rewrite  x  and 
y  dynamics  as 


x 

y 


ux 

Uy 


c  6  + 


Fx 
Fy  . 


where 


Fx  =  [c  ipsOstp  —  ccpsip]v  +  [c<pcips9  +  s(psip]w, 
Fy  =  [ccpcip  +  s9scpsip]v  +  [—cipstp  +  c<ps9sip]w, 


and 


ux  =  u  cip 
uy  =  u  sip. 


(5) 


The  dynamic  equation  for  x  and  y  can  be  manipulated  as 
follows 


X 

'  Fx  ' 

u°c 

c  9  + 

ux 

.  y  . 

— 

.  Fy  . 

+ 

Uy 

L  i/c  J 

.  Uy  . 

where  ux  =  ux  —  uXc  and  uy  =  uy  —  uVc.  Again,  there 
is  another  term,  [uXc  —  u°c,uVc  —  u"JT,  that  should  be 
accounted  for  in  the  analysis,  where  uXc  =  uccipc,  u°  = 
uCocip°,  etc.  This  term  can  be  made  arbitrarily  small  by 
increasing  the  bandwidth  of  the  command  filter  that  is  used 
to  compute  uc  and  ipc  (and  their  derivatives)  from  u°  and 
ip°.  The  effect  of  this  term  is  rigorously  analyzed  in  [8],  Due 
to  lack  of  space,  the  arguments  are  not  repeated  herein.  We 
select  signals  [it°c,it°JT  as 


U°Xc 

cos (6)  (  Fx  KxyX  +  xc ) 

u° 

L  yc  J 

cos(6»)  (  Fy  Kxyy  +  yc) 

where  Kxy  is  time  varying  and  positive.  The  selection  of 
the  control  signal  above  yields  the  x  and  y  position  error 
dynamic  equations: 


x 

y 


Fxyx 

Fxyy 


Ux 

Uv 


c  9 


(7) 


Two  questions  remain:  how  should  we  manipulate  the 
ux  and  iiy  terms  to  allow  a  rigorous  stability  analysis  that 
accounts  for  them;  and,  how  should  <  and  ip°  be  specified 


to  achieve 


?  These  issues  are  addressed  in  the 


following  subsections. 

Simplification  of  ux  and  uy.  These  terms  can  be  ma¬ 
nipulated  by  two  very  similar  approaches  (derived  in  [1]). 


In  either  case  the 
following  form 


ux 

U,, 


term  can  be  expressed  in  the 


=  Au  +  Bg(ip)ip. 


Thus,  the  position  error  dynamics  can  be  expressed  as 


X 

.  y  . 

Kxyy 

(. Au  +  Bg(ip)  ip)  cos  (0) 


which  is  a  form  suitable  for  stability  analysis.  The  first  term 
will  be  accommodated  by  the  u  backstepping  control.  The 
second  term  will  be  accommodated  by  the  ip  backstepping 
control.  Selecting  Approach  1  in  [1],  we  define  Ubs  and  yy)s 
backstepping  terms  as 


Ubs  =  c9(cipcx  +  s  ipcy) 


(8) 


and 

ipbs  =  C  9  ■ 


,  cos  (ip)  —  1  ,  sin(U) 

u  c  ipc - = - u  sip , 


iP 

,  cos  (ip)  -  1 

U  S  Ipc - = - b  U  C1p( 


iP 


Ip 
sin(^>) 

4> 


x  (9) 


Vi- 


B.  Mode:  D  Translation 


The  objective  of  this  component  of  the  outer  loop  is  to 
select  w°(t)  to  force  dpt)  to  converge  to  dc{t),  where  dc(t) 
and  dc(t)  are  known  command  signals. 

Using  the  last  row  of  the  R  matrix,  the  dynamics  of  d  are 

d  =  —usin(9)  +  cos (9)  sin (<p)v  +  cos (9)  cos (<p)w. 


Since  desired  values  for  u,  (p,  and  9  are  already  specified  and 
v  is  not  controllable,  assuming  that  9  ^  90°  and  (p  ^  90°, 
we  will  select  the  commanded  value  of 

Q  wsin(0)  —  cos(0)  sin(</>)u  —  Kdd  +  dc 
Wc  cos (0)  cos (cp) 

for  w  to  control  d.  This  yields  the  closed  loop  depth  error 
dynamic  equation 

d  =  —  Kdd  +  c9ccpw  +  c9c<p(wc  —  w°)  (10) 


where  the  last  term  is  dropped  in  the  subsequent  analysis 
due  to  space  limitations,  but  can  be  analyzed  rigorously  by 
methods  similar  to  those  in  [8], 


Selecting  the  Lyapunov  function  (as  in  [1])  we  can  define 
the  backstepping  term 

Wbs  =  c9ccj)d  (11) 

that  will  be  incorporated  into  the  w  inner  loop  control  signal 
to  cancel  the  sign  indefinite  portion  in  the  stability  analysis. 

V.  MIDDLE  LOOP  -  ATTITUDE  CONTROL 

This  control  loop  will  be  used  by  each  of  the  outer 
loops  and  therefore  it  is  described  separately.  The  inputs  to 
this  outer  loop  are  roll,  pitch,  and  yaw  commands,  ©c  = 
[(f>c(t),  0c(t),  V’c(f)]  and  the  derivatives  of  these  signals, 
which  are  produced  by  command  filtering.  Additional  inputs 
are  the  roll,  pitch,  and  yaw  backstepping  terms, 

For  attitude  control,  based  on  eqn.  (2),  we  define  the  signal 

00°  =  +  0C  —  ObsJ 

where  Kq  is  a  positive  definite  matrix  and  0(f)  =  0(f)  — 
©c(f).  Using  this  definition,  the  closed-loop  tracking  error 
corresponding  to  eqn.  (2)  is 

O  =  +  fl(w  —  uoc)  +  fl(wc  —  w“)  (12) 

=  — AqO  T  Oc  T  flti)  —  ©6s 

4>  =  -KeQ  +  nCj~Qbs  (13) 


Fig.  1.  2D  Position  vs.  Time:  Blue  line  is  the  actual  vehicle  trajectory, 
black  line  is  the  command,  and  the  red  line  is  hltered  command 


With  this  choice  of  the  control  signal  and  the  fact  that 
Vb  =  Vb  —  Vbc  and  Co  =  Co  —  Coc ,  the  dynamics  of  the  tracking 
errors  are 

u  =  —Kuu  -  ubs 
w  =  - Kww  -  wbs 

Co  =  -KUUJ  -  LObs 


where  the  term  —  io°)  is  dropped  after  eqn.  (12). 

This  term  can  be  made  arbitrarily  small  by  increasing  the 
bandwidth  of  the  command  filter  that  is  used  to  compute 
uoc  and  Coc  from  co°.  The  effect  of  this  term  is  rigorously 
analyzed  in  [8].  Due  to  lack  of  space,  the  arguments  are  not 
repeated  herein.  To  compensate  for  the  sign  indefinite  Co  term 
in  the  stability  analysis  the  term  cobs  in  Section  VI  is  defined 
as 

O0bs  =  HT©.  (14) 

VI.  INNER  LOOP 

The  inputs  to  the  inner  loop  are  uc,  iic,  wc,  wc,  toc,  Coc,  ubs, 
Wbs, and  Ubs.  Each  of  these  input  signals  is  defined  by  one  of 
the  middle  or  outer  loops  as  will  be  described  in  the  sequel. 
Each  of  the  signals  uc,  wc,  and  toc  are  commands  to  the 
inner  loop.  The  signals  uc,  wc ,  and  Coc  are  the  derivatives 
of  the  commands.  The  signals  are  ubs,  wbs  and  Lobs  are 
backstepping  terms  defined  to  cancel  sign-indefinite  terms 
in  the  stability  analysis. 

The  inner  loop  control  signals  are 

Ul  J\d (Fnlin  CCvVb  T  Vbc  t^bbs)  (15) 

U2  =  J (Mnlin  KuCj  T  U0C  00bs)  (16) 

with  the  thrust  vector  defined  as 


Lf 

-1 

Ml 

Lm 

.  U 2 

where  vb  =  vb  —  vbc,  Co  =  to  —  c oc,  and  Kv  and  Ku  are 

positive  definite  matrices. 


VII.  AUVFest  RESULTS 

During  AUVFest,  we  accomplished  12  hours  of  in-water 
demonstration  time.  The  goal  was  to  accurately  navigate 
in  the  harsh  environment  under  the  hull  of  a  ship  while 
maintaining  the  distance  from  the  ship  for  optimal  imag¬ 
ing  sonar  positioning.  All  hull  search  vehicle  behaviors 
were  demonstrated  with  the  following  unique  capabilities: 
autonomous  mission  execution  with  intervention  capability, 
hull  search  conducted  using  side  look  sonar,  sensors  parame¬ 
ters  optimized  by  operator  during  mission,  real-time  topside 
display  of  Sound  Metrics  DIDSON  High  Definition  Imaging 
Sonar  and  Marine  Sonics  1800kHz  Side  Looking  Sonar,  ve¬ 
hicle  position  and  status  information  embedded  in  DIDSON 
sensor  data  and  Joint  Architecture  for  Unmanned  Systems 
(JAUS)  communication  protocol  implemented  on  UUV.  The 
2D  position  plot  is  shown  Figure  1.  Great  trajectory  tracking 
performance  can  be  noticed  since  the  vehicle  maintained 
its  track-line  even  with  the  presence  of  side  currents.  This 
is  greatly  desired  capability  for  this  type  of  mission  since 
100  percent  ship-hull  coverage  is  required.  The  position  plot 
showing  north,  east,  down,  and  altitude  position  versus  time 
is  shown  in  Figure  2,  while  the  attitude  (roll,  pitch,  yaw) 
plot  is  shown  in  Figure  3.  Vehicle’s  horizontal  and  vertical 
velocities  are  shown  Figure  4,  while  the  angular  rates  (roll, 
pitch,  yaw  rate)  plot  is  shown  in  Figure  5.  Excellent  tracking 
performance  can  be  observed,  for  instance,  maximum  depth 
variations  were  around  5  cm,  maximum  roll  variations  were 
around  4  degrees,  while  maximum  variations  in  pitch  were 
around  2  degrees. 


Fig.  2.  North,  East,  and  Down  Position  vs.  Time:  Blue  line  is  the  actual  Fig.  4.  Velocities  vs.  Time:  Blue  line  is  the  actual  vehicle  velocity,  black 

vehicle  trajectory,  black  line  is  the  command,  and  the  red  line  is  filtered  line  is  the  command,  and  the  red  line  is  filtered  command 

command 


Fig.  3.  Attitude  vs.  Time:  Blue  line  is  the  actual  vehicle  attitude,  black 
line  is  the  command,  and  the  red  line  is  filtered  command 


VIII.  CONCLUSION  AND  FUTURE  WORK 

This  article  has  discussed  the  design  and  derivation  of 
a  command  filtered,  vector  backstepping  approach  to  de¬ 
sign  a  stable  translational  and  attitude  controller  (i.e.,  y  = 
[x(f),  y(t),  d(t),  0(f)]T)  applicable  to  an  underactuated 

AUV.  The  mission  scenario  specifies  the  position  and  attitude 
commands  which  are  command  filtered  to  produce  inputs 
(together  with  their  derivatives)  for  the  outer  loop  and 
middle  loop  controllers.  The  commands,  such  as  horizontal 
and  vertical  velocities  ( uc,wc )  and  angular  rates  (pc,gc,rc) 
are  generated  by  the  outer  and  middle  loop,  command 
filtered,  and  are  inputs  (together  with  their  derivatives)  to 
the  velocity  and  angular  rate  inner  loop  controllers.  The 
inner  loop  determines  the  appropriates  thrust  forces.  The 


Fig.  5.  Angular  Rates  vs.  Time:  Blue  line  is  the  actual  vehicle  angular 
rate,  black  line  is  the  command,  and  the  red  line  is  filtered  command 


article  has  presented  both  the  control  law  derivation  and 
the  actual  in-water  results.  The  plan  is  to  design  additional 
outer  loop  controllers  to  increase  the  vehicle  maneuverability 
and  capability.  The  outer  loop  controllers  are  defined  for 
different  vectors  of  outer  loop  control  variables  as  specified 
by  the  vector  of  outputs  y.  Other  example  behaviors  expected 
to  be  implemented  in  the  future  include  translation  with 
unspecified  attitude  y  =  [ x(t),y(t),d(t),u(t)]T  and  station 
keeping  y  =  [x,y,d,^]T. 
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